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Abstract 
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for redundancy resolution are briefly discussed. 


1. Introduction 

' g l? s Y S devdoVed. In recent years redundant manipulators have been the subject 
of considerable research, and several uses for redundancy and methods to resolve redundancy 
have been suggested Much of the research on redundant manipulators has been explicitly or 
implicitly 1 base^on the Jacobian pseudo-inverse approrrch [1] for the ut.hzat.on of redundancy 
through local optimization of some criterion functional. 

This paper presents a different approach to the kinematics of redundant ^nipulatos which 
is based on a manifold mapping reformulation that stresses global, rather than local, kine 
matic analysis Within this framework, the infinite number of redundant manipulator inverse 
Enematk solutions are naturally interpreted as a finite set of “self-motion manifolds. The self- 
motion manifold approach is a useful foundation for studying redundant manipulator bnemat- 
ics Additionally redundancy resolution can be equivalently posed as the control of self-motions 
andth* self ^motion manifolds are useful for investigating, interpreting, and formulating both 
local and global redundancy resolution techniques. 

The resolution of the redundancy can be implemented by direct control of a set of self-motion 
partmXs by dir<£ control of a related set of user-defined kinemat.c funct.ous or through 
the optimization of an objective function. Redundancy resolution can also be posed as a local 
or global problem. 
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2. Kinematics of Redundant Manipulators 

of n joint coordinite% h t"o e ™et C fUnCli ° n " hkh rdates a set 

X = m (1) 

sefofll^ ki “ * determining the 

0 = /-‘(x). (2) 

(2). Each solution cm«pond°To ^distinct manipullto° U vi ”*F ot j °'d * d" 8 '?* ” h ' ch ? atisfy 

set of smooth manifolds. 10nS Can S rou P e ^ ^ ° a finite and bounded 
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x = J ( 0)0 
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referred to as the inverse kinematic soluLn/ratherth^n^)^ mVerSe S ° lutl ° n t0 (3) 18 ° ften 
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reformulation and the interpretation of redundant inverse kinematic solutions in terms of ^self- 
motion manifolds. This approach gives a natural mterpretation to ^ ' 

useful insight into the local redundancy resolution schemes in (4) and (5), and suggests new 
approaches to redundancy resolution. 

3. A Manifold Mapping Reformulation of Manipulator Kinematics 

Only revolute jointed manipulators will be considered in this paper, although manipulators 
constructed from other lower pair joints can be similarly treated. In order to globally analyze 
manipulator kinematic functions it is useful to rephrase the forward and inverse kinematic 
problems in terms of manifold mappings. From a point-wise mapping perspective, the forward 
kinematic function in (1) maps a unique joint configuration, 9 , to an end-effector location, x. 
x = f(9). The set of all possible joint configurations forms a space, termed the joint space or 
“configuration space,” which has a simple manifold structure. Similarly, the set of all possible 
end-effector locations forms the “workspace,” which also has a manifold structure. 

First consider how a manipulator configuration space can be developed as a manifold. Let 
6j denote the joint rotation angle for the j th revolute joint. If the motion of the j joint is 
not limited due to mechanical stops, 0, can take on all values in the interval jl, The 
identification of the two end-points of the interval, x and -tt, yields a circle, denoted by the 
symbol S 1 in Figure 1. The configuration space, C, of an n-revolute-jointed manipulator is a 
product space formed by the n-times product of the individual joint manifolds: 


C = S 1 x S 1 x ■■■ x S 1 = T n 


( 6 ) 


where T n is an n-torus, which is a compact n-dimensional manifold. Each of the circles that 
make up the torus is termed a generator of the torus, and is physically equivalent to a 2n 
rotation of one joint. There is a one-to-one correspondence between each point m the n-torus 
configuration space manifold and a discrete manipulator configuration. For example, the lii 
planar manipulator in Figure 2a has a 2- torus configuration space shown in rigure 2 b. 

While the torus geometry properly captures the topology of the configuration space manifold, 
there are times when other representations of the torus are useful. For example, the 2-torus 
representation of the 2 R manipulator configuration space can be presented as a square with 
dimension 2 tt by “cutting” the torus along two generators, as shown m Figure 3. i he 3-torus 
configuration space of a 3R manipulator can not be directly viewed in a 3-dimensional space, 
but it can be presented as a cube by cutting along the 3-tori generators, as in Figure 3. 1 hese 
configuration space representations are also useful for plotting trajectories and surfaces in u- 
space, and all of the “cubes” in Figures 4 and 5 represent 3-tori. 

To establish the geometry of the workspace, attach a frame to the manipulator end-effector. 
The manipulator’s workspace manifold, W, is the set of all possible locations and orientations 
of this frame as the manipulator joints are swept through all points of the configuration space. 
The geometric characterization of W is more complex than the torus characterization of the 
configuration space [2,4]. Briefly, the workspace has a “layered” or sheet-like structure. 


The forward kinematic function can be viewed as a mapping of points from the configuration 
space to the workspace. More importantly, one can consider the action of the forward kinematic 
function as the global rearrangement of the configuration space manifold to produce the workspace 
manifold : 

/(0): C — > W. (7) 


Roughly speaking, the forward kinematic map “rips” the configuration space manifold apart 
into pieces; distorts each piece; and combines the distorted pieces to form W. A more detailed 
description of this mapping can be found in [2,4]. 
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4. Redundant Inverse Kinematic Solution: Self-Motion Manifolds 

For non-redundant manipulators, the inverse kinematic solution (also termed a preimage ) 

/ (x) of a regular end-effector location is a bounded set of discrete configurations. It is 

Known [5J that a 6 R manipulator with arbitrary geometry can have up to 16 inverse kinematic 
solutions. 

Let r = n - m be the relative degrees of redundancy. Since / is a smooth function operating 
on a compact manifold, C, f 1 (x) must be an r-dimensional submanifold of the configuration 
spa.ce 16J if x is a regular value. The preimage submanifold may actually be divided into several 
disjoint manifolds. Formally, let a redundant inverse kinematic solution be denoted as the union 
of one or more disjoint r-dimensional manifolds: 

/ -1 ( x ) = U MM) ( 8 ) 

I 

where M,(i0} is the i th r-dimensional manifold in the inverse kinematic preimage and MM) n 
M i\f> ~ “ f? r * T J- Each of the preimage manifolds can be physically interpreted as a “self- 
motion which is a continuous motion of the manipulator joints that leaves the end-effector 
motionless. 


Definition. Each of the disjoint r-dimensional manifolds in the inverse kinematic 
preimage will be termed a self-motion manifold. 


n 


is the number of self-motions in the preimage of x (bounds on the value of n. m will be 
reviewed in Section 5), and a given end-effector location may have more than one associated 
distinct self-motion. The multiply disjoint self-motions are akin to the distinct poses that make 
up non-redundant manipulator inverse kinematic solutions. Each M, can be parametrized bv 
a set of r independent parameters, ={&,••• , Vv}, which can be thought of as generalized 
coordinates for the self-motions. For a given end-effector location there is a unique choice (up 
to isomorphism) of self-motion parameters. However, the choice of the self-motion parameter 
can vary in different well-defined regions of the workspace [2]. The self-motion manifolds are 
best illustrated using two examples: a planar 3R manipulator (Figure 4) which is redundant 
with respect to the position of its end-effector, and a 4R regional manipulator which is similar 
to an elbow” manipulator (Figure 5). 

The self-motion manifolds of the 3 R manipulator can be computed as follows. Let ii>, which is 
the orientation of the third link relative to a fixed reference system, be the parameter describing 
the internal motion of the manipulator (there are other valid, useful, and physically meaningful 
choices for the self-motion parameter). For a given end-effector location, (x ee ,y ee ), and an 
arbitrary value of V>, there are two possible sets of joint angles, {0 la , 02a, ha } and {0 lb , 0 2in 0 3b \, 
which can be determined by evaluating the following equations: 


f?2 — + J lee + l\ — 2l 3 (x ee cos + y ee sin VO 


a = atan2(y ee - / 3 sin V>, x ee - l 3 cos VO 

T cc °-‘( i + J ,;*0 (9) 

{01a, 02a, 03a} = {(a + f?), (7 - 7r), (ip - ot - 77 - 7 + tt)} 

{016,026,036} = {(<*-f?),(7r-7),(V’-a + »? + 7-7r)} 

1 A regular point of the map / is a discrete configuration, 6 , for which f(0) is not singular (the 
Jacobian ot / remains full rank). A regular value is an end-effector location x = f(0) where 6 
is a regular point. A critical point is a configuration, 0, such that f(0) is singular (the Jacobian 
of / loses rank). A critical value is an end-effector location x = f(0) where 0 is a critical point. 
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, , . ; nf links 1 2 and 3. As xb is swept through its feasible range 

on** Jrl 2 equations 1 (9) will generate two 1-dimensional manifolds in the configuration space 
These maillfo^ds'^ay remain Separate (or all values of * in which case there are wo 
self-motions, or the two branches may meet at two points (^TvCks 1 and 2l to form one 

— of * 

but appSr as non-closed curves because of the cubic 3-torus represen at, on in Figure 4. The 

two distinct self-motion manifolds in the pre, mage of point 1 j elb P ow l 

hnw” and “down elbow” self-motions which are an analogous generalization o .the up eioo 
and “down elWw” configurations of a non-redundant two-link manipu a or. Self-motions can 
be thought of as a natural generalization of the non-redundant manipulator concept of pose 
to redundant manipulators. In both cases, the self-motion manifolds are diffeomorphic to a 
circle However the preimage of point 1 contains a generator of the configuration space ( 
joint rotation) 1 while^t he other preimage does not. These two self-motion manifolds are not 

homotopic 3 . 

Now consider the more complicated 4 R manipulator in Figure 5. The kinematic parameters 
of this arm (using the modified Denavit-Hartenberg convention as in [7]) are = Q ° ~ 0l Let 

the Telf-motion parameter^Vrbe the a^gle between the plane containing the third and fourth 
links and the vertical plane passing through joint axis 1. The 

inverse kinematic solutions, {0ia,02«,03a,04a} , ^26,^36, M, j^lc XktMian 

e 3d ,e Ad }, given an end-effector location, x = (x ee , jfee, *ee), and a value lor the sell motion 

parameter, ip. 

Define the following variables, which are purely functions of the end-effector location and the 
link length parameter, l. 


R-2 — V ' x< ee d” Vee' 

cos/? = x ee / R2] 

COS £ = R2/R3', 

cos 7 = R3/2I', 


#3 = \/ x ie + vie + z ee- 
sin (3 = J/ce/^2 ft = ®^an2(j/ee5 ^ee)* 

sin£ = z te jRz\ £ — atan2(z ee , /?2)« 

sin 7 = (1/2 OV 4 1 2 -Rj; 7 = a<an2(sin7,coS7). 


( 10 ) 


There are two unique values of 64 which satisfy the inverse kinematic function: 

04 a = 27 ; 046 = “04 a 


( 11 ) 


A smooth map f :X-+Y (where X and 7 are manifolds) is a diffeomorphism if it is one-to-one 

and onto, and f~ l :Y -* X is smooth. X and Y are diffeomorphic if such an / exists. 

Two maps fir X -* Y and U: X -» Y are homotopic if there exists a smooth map, F: X x l -> 

Y such that V(x, 0) = / 0 (x) and F(x,l) = fi( x )- In other words ’ f° c f a V, be def ° rmed to l\ 
through a smoothly evolving family of maps, and two self-motion manifolds are homotopic if 

one can be continuously deformed into the other continuously on the surface of the configurati 
space torus. 
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There are four unique values of 0 2 (two corresponding to each value of 0 4 in (12)): 

^ 2a ~ cos [ s ^ n £ sin 7 ~ cos £ cos 7 cos ip] 02b = ~0 2a 

0 2c = cos ! [sin £sin 7 + cos ( cos 7C0S ip] 0 2 j = -0 2c . 

There are four corresponding values of 0 X which can be computed as follows: 


9u = atan2 f _ sin V ’ cos 7 (cos ( sin 7 -f sin £ cos 7 cos V>) 1 

1 sin^2a ’ sin 0 2a J ff ib - 0 U ± n 


0 ic = atan2 


sin 02a ’ sin 0 2a 

T sin 0 cos 7 (— cos ^ sin 7 + sin £ c os 7 cos ip 

L si 




Old = Ole ± 7T 


( 13 ) 


sin 0 2c sin 0 2c 

Similarly, there are four corresponding values of 0 3 which can be computed as follows: 


0 3a = atan2 f - COS ^ sin ^ sin £ cos 7 + cos £ sin 7 cos ^ 1 

L sin 0 2 « ’ sin 0 2a J 

$ 3c _ a ^ an 2 f cos §_ s * n V* sin f cos 7 + cos £ sin 7 cos ^>1 

sin 02 C ’ sin 0 o r J 


sin 0 2c 


036 = 03a ± 7T 

03 d = 03c i IT 


(14) 


5. Characterizations of the Self-Motion Manifolds and the Jacobian Null Space 

c A anTe e fS °' “*“■ 

l h J, 0re ^ ,^ n ^volute-jointed redundant manipulator can have no more self 
potions than the maximum number of inverse kinematic solutions of a non-redun 
dant manipulator of the same class. That is, for a fixed end-effector location 7edun 

d imnti P r enCal ' re f W7 l al l and s P atial manipulators with an arbitrary number of ’revolute 
joints can respectively have as many as 2, 4, and 16 distinct self motions 

This^«u“?a^uanv d h IS M d f ,St0rted r , d ™ensionaI torus lying in the n-torus configuration space 
be a O^imerniionaf torus* oTaTotat “ dant mMi P uktors “ the inverse image Lst 

hom^Movef W k ich are ho T t [ jpic t0 each other torm a homotopy class. The notion of a 
Mths Whnf S h “ pr f v ' ous| y be® used in 8] to characterize different redundancy resolution 
paths While an exact bound on the possible number of self-motion homotopySSrwS 
or a given manipulator has not been rigorously determined: 

P 7 .t“ 3: A " ''- revohte -j° i ’' tcd f» > V mtia I manipulator can hare as many 
as Z > different self-motion homotopy classes. 
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tangent space. 

Theorem 4: The null space of the Jacobian matrix, evaluated at a particular joint 
configuration, 0 o , is the tangent to the self-motion manifold at 9 0 . 

Theorem 4 is particularly useful for interpreting instantaneous redundancy resolution tech- 
niques, such as (4) and (5). 

6 User-Defined Kinematic Functions and the Augmented Jacobian 

SPUE! * “not always physically 'meaningful or the direct parameters of mterest » 
performing a task. 

be expressible as independent functions of rp: <j> = {M 0 W)’ • • 

rfmotTonptlmeS^ 

related to the manipulator joint angles through the baste augmented Jacobi . 

J]\dx/dO} (15) 

■J*J dtp/dO ■ 

the augmented Jacobian of the form. 


j]=[o 


gSSSiiS 

rank: [,1,. _.i r JJ r wl 1 r, 7 i 


Since the matrix in (17) is square, a deficiency in its rank can be determined by investigating 
its determinant: 


T 

33 t r = det(JJ T ) • det[J*(I - J* J)JJ] 
Jt4 J./, J 
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rank »hen det[J*(I - jtjJjJ] = 0 . This wi| , occur when ^ rink . deficient 2) 

ortE"^ 1 ) Hh' ” "T 

orthogonal to the null space of J, the the null space of J is in the null space of TWf 
e augmented Jacobian will also lose rank when N( J) n N( J^) ^ 0 where MJ) and Nf J^ 
are the null spaces of J and (condition 3). * { ’ d 

7. Alternatives for Redundancy Resolution 

W*)> m), or the related coordiLt^fxm ^m ^Louehou lhe 

can be'used^o^ervo ^he^'n^nipulator^lon^the^ ' ^ f -H 0 '-’ * W l' a " d joint based control 
are examples of i^JtSZS^SSf , < 9 > “ d <"»4> 

^to?e^ 

The criterion for optimizing g{9) with the constraint x = 30 is: 


B— = 0 

dO 


(19) 


19) is the result (I rT ' Ration 
optimizing g(0) generally lSdoJacoht. ^ J 1 aCobla “ Method. Other methods for 

defining MJ ^ ch “ ( 4 ) and ( 5 )- However, by 

special case of trajectory tracking. 1C ° P irruzatl on can also be reformulated as a 

ri as , either IOCal ° r * lobal P roblems ' local ap- 
approaches, a s.obil LJJ’ot the o&SZ S 

resolution ^obL^^fth^xed 0 emd -effector b^^The^'ilfto fin^theconfi® & 
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The concept of a self-motion manifold can be useful for developing other approaches to global 
redundancy Solution. Again consider the case of redundancy resolution for fixed end-effector 
location. Let g(6) be the objective function. For fixed end-effector location, B is implicitly a 
function of V>. Global redundancy resolution is then equivalent to finding. 


max ( 


max < 7 , 


(* = V 


> Warn 


) 


( 20 ) 


where gM) is the restriction of g(ip) to the i th self-motion manifold. The local maxima and 
minima of the resolution function can be found as the roots to n sm polynomials: 


dgdfP) 

dxj> 


= 0 


(i — !,•••) n jro)' 


( 21 ) 


the globally optimal solution is selected by evaluating g{ip) at each of the locally optimal roots 
to equations &1). Once the optimal set of self-motion parameters has been determined the 
^poXg configuration, «■> be computed from the mverse hnemete toctam 

To extend this approach to redundancy resolution along a trajectory, the polynomial equations 
could be solved along the path, and the multiple trajectories compared to determine the glob y 
optimal one. 

9. Conclusions 

Self-motions are inherent in redundant manipulators, and understanding their characteriza- 
tion and control is important for establishing useful redundancy resolution techniques. Th 
paper reviews a global manifold mapping reformulation of manipulator kinematics inw tnc 
self-motions are naturally interpreted as sub-manifolds of the configuration space. Ways 
characterize these self-motion manifolds are presented. Redundancy resolution 
be naturally reformulated and reinterpreted in terms of self-motion manifolds, rather than t e 
Jacobian null space. This approach yields useful global insight into redundancy resoluti . 
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Figure 1: Revolute Joint Configuration Space Manifold 
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(a) Planar 2R Manipulator 


(b) 2-torus Configuration Space Manifold 


Figure 2: Configuration Space of a 2 R Manipulator 
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Figure 3: Square and Cube Representation of a 2-torus and 3-torus 


Preimage of 


Preimage of Point 1 



Figure 4: Self-Motion Manifolds for Two Regular Values in the Workspace of a 3i? 
Planar Manipulator 
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Figure 5: 4/? Elbow-like Regional Manipulator 





Projection onto 61 - 62-63 torus 


Projection onto 6 2 - 6 3 - 6 4 torus 


Figure 6: 4 R Elbow-like Manipulator Self-Motion Manifolds 



